% verify the stance hip roll angle


sleg = line([0 0],[0 0],'Color','r');
hold on;
l = 0.3;
nsleg = line([0 0],[1 1],'Color','b');
hip = line([0 1],[0 0],'Color','m');
% torso = line([0 0],[0 0],'Color','g');
for k = 1:size(s_hip_3D,1)
%     axis equal
angle = (s_hip_3D(k)+pi/2);
    set(sleg, 'XData', [0 cos(angle)], 'YData', [0 -sin(angle)], ...
            'erasemode', 'normal');    
angle_ns= (ns_hip_3D(k)+pi/2);
    set(nsleg, 'XData', [1 1-cos(angle_ns)], 'YData', [0 -sin(angle_ns)], ...
            'erasemode', 'normal');   
    drawnow;
    pause(0.2)
end